package cn.cuilan.other.xlsx;

import java.math.BigDecimal;
import java.math.RoundingMode;

/**
 * 计算两点经纬度之间的距离
 *
 * @author zhangyan
 * @since 2023/1/9
 */
public class GeoUtil {

    /**
     * 默认地球半径，赤道半径(单位m)
     */
    private final static double EARTH_RADIUS = 6371000;

    /**
     * 地球半径（千米）
     */
    public final static double R = 6371.000;

    /**
     * 转化为弧度(rad)
     */
    private static double rad(double d) {
        return d * Math.PI / 180.0;
    }

    /**
     * @param lon1 第一点的精度
     * @param lat1 第一点的纬度
     * @param lon2 第二点的精度
     * @param lat2 第二点的纬度
     * @return 返回的距离，单位m
     */
    public static double getDistance(double lon1, double lat1, double lon2, double lat2) {
        double radLat1 = rad(lat1);
        double radLat2 = rad(lat2);
        double a = radLat1 - radLat2;
        double b = rad(lon1) - rad(lon2);
        double s = 2 * Math.asin(Math.sqrt(Math.pow(Math.sin(a / 2), 2) + Math.cos(radLat1) * Math.cos(radLat2) * Math.pow(Math.sin(b / 2), 2)));
        s = s * EARTH_RADIUS;
        s = Math.round(s * 10000) / 10000;
        return s;
    }

    /**
     * 计算中心经纬度与目标经纬度的距离（米）
     *
     * @param centerLon 中心精度
     * @param centerLat 中心纬度
     * @param targetLon 需要计算的精度
     * @param targetLat 需要计算的纬度
     * @return 米
     */
    public static double distance(double centerLon, double centerLat, double targetLon, double targetLat) {
        double jl_jd = 102834.74258026089786013677476285;// 每经度单位米;
        double jl_wd = 111712.69150641055729984301412873;// 每纬度单位米;
        double b = Math.abs((centerLat - targetLat) * jl_jd);
        double a = Math.abs((centerLon - targetLon) * jl_wd);
        return Math.sqrt((a * a + b * b));
    }

    /**
     * 通过经纬度计算两点之间距离，单位：米
     *
     * @param lat1 第一个位置的纬度
     * @param lon1 第一个位置的经度
     * @param lat2 第二个位置的纬度
     * @param lon2 第二个位置的经度
     * @return 计算两点之间距离
     */
    public static double distance2(double lat1, double lon1, double lat2, double lon2) {
        double latDistance = Math.toRadians(lat2 - lat1);
        double lonDistance = Math.toRadians(lon2 - lon1);
        double a = Math.sin(latDistance / 2) * Math.sin(latDistance / 2)
                + Math.cos(Math.toRadians(lat1)) * Math.cos(Math.toRadians(lat2))
                * Math.sin(lonDistance / 2) * Math.sin(lonDistance / 2);
        double c = 2 * Math.atan2(Math.sqrt(a), Math.sqrt(1 - a));
        double distance = R * c * 1000; // 单位转换成米
        distance = Math.pow(distance, 2);
        BigDecimal bigDecimal = BigDecimal.valueOf(Math.sqrt(distance));
        return bigDecimal.setScale(2, RoundingMode.HALF_UP).doubleValue();
    }

    public static void main(String[] args) {
        // P1-4  120.13727591666667  38.432009
        // p1-3  120.142893          38.42757683333333
        System.out.println(getDistance(120.13727591666667, 38.432009, 120.142893, 38.42757683333333));
        System.out.println(distance(120.13727591666667, 38.432009, 120.142893, 38.42757683333333));
        System.out.println(distance2(120.13727591666667, 38.432009, 120.142893, 38.42757683333333));
    }

}
